A Geometric Approach to the Optimal Control of Nonholonomic Mechanical Systems

In this paper, we describe a constrained Lagrangian and Hamiltonian formalism for the optimal control of nonholonomic mechanical systems. In particular, we aim to minimize a cost functional, given initial and final conditions where the controlled dynamics are given by a nonholonomic mechanical system. In our paper, the controlled equations are derived using a basis of vector fields adapted to the nonholonomic distribution and the Riemannian metric determined by the kinetic energy. Given a cost function, the optimal control problem is understood as a constrained problem or equivalently, under some mild regularity conditions, as a Hamiltonian problem on the cotangent bundle of the nonholonomic distribution. A suitable Lagrangian submanifold is also shown to lead to the correct dynamics. Application of the theory is demonstrated through several examples including optimal control of the Chaplygin sleigh, a continuously variable transmission, and a problem of motion planning for obstacle avoidance.